#include <Servo.h> //调用舵机库函数
#include <Wire.h>        //调用IIC库函数
#include "MH_TCS34725.h" //调用颜色识别传感器库函数
// #include <DHT.h>//温湿度
// #include <Adafruit_GFX.h>
// #include <Adafruit_SSD1306.h>//调用oled屏幕库函数

// #include <U8g2lib.h>


// // 定义 DHT11 传感器引脚和类型
// #define DHTPIN 2
// #define DHTTYPE DHT11
// DHT dht(DHTPIN, DHTTYPE);

// // 轻量字体
// #define USE_SMALL_FONT 1

// 定义舵机对象
Servo myServo1;
Servo myServo2;

// 定义舵机控制引脚
const int servoPin1 = 3;
const int servoPin2 = 4;

//颜色传感器不同通道值设置
MH_TCS34725 tcs = MH_TCS34725(TCS34725_INTEGRATIONTIME_50MS, TCS34725_GAIN_4X); //设置颜色传感器采样周期50毫秒
enum{slowForward=1,fastForward,Stop};//定义刷子状态：慢刷、快刷、停止，分别对应1、2、3

void setup() {
  // 初始化串口通信
  Serial.begin(9600);
  Serial.println("Color View Test!"); //串口打印：Color View Test!

  u8g2.begin();
  dht.begin();

  // 将舵机连接到指定引脚
  myServo1.attach(servoPin1);
  myServo2.attach(servoPin2);

  //检测是否有颜色传感器模块
  if (tcs.begin()) {                 //如果检测到颜色传感器模块
    Serial.println("Found sensor");  //串口打印 Found sensor
  } else {                           //如果没有检测到颜色传感器模块
    Serial.println("No TCS34725 found ... check your connections");//串口打印：没有找到颜色识别传感器模块
    while (1); // halt! //程序陷入死循环
  }
  Motor_pin_init();//直流电机引脚初始化
  delay(500);
}

void loop() {
  Get_Color_Data();
  delay(2000);
}
